#include <Wire.h>
#include <Servo.h>
#include <EEPROM.h>
#include <Depecabot3.h>

Depecabot robot;

int error,posicion,giro;

void setup(void)
{
  robot.init();
  robot.sensorLinea.init();
  robot.lcd.clear();
  robot.lcd.print("Calibrando");
  robot.sensorLinea.calibrate();
  robot.lcd.clear();
}
void loop(void)
{
  robot.sensorLinea.readCalibrated();
  posicion=robot.sensorLinea.posicion();

  error=posicion-1500;
  giro=error*0.015;
  robot.motoresLinealAngular(50,giro);
}





